The Isoconditioning Loci of A Class of Closed-Chain Manipulators 
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Abstract 

The subject of this paper is a special class of closed- 
chain manipulators. First, we analyze a family of two- 
degree- of- freedom (dof) five-bar planar linkages. Two 
Jacobian matrices appear in the kinematic relations 
between the joint-rate and the Cartesian- velocity vec- 
tors, which are called the ''inverse kinematics" and the 
''direct kinematics" matrices. It is shown that the loci 
of points of the workspace where the condition number 
of the direct-kinematics matrix remains constant, i.e., 
the isoconditioning loci, are the coupler points of the 
four-bar linkage obtained upon locking the middle joint 
of the linkage. Furthermore, if the line of centers of 
the two actuated revolutes is used as the axis of a third 
actuated revolute, then a three- dof hybrid manipulator 
is obtained. The isoconditioning loci of this manip- 
ulator are surfaces of revolution generated by the iso- 
conditioning curves of the two- dof manipulator, whose 
axis of symmetry is that of the third actuated revolute. 

KEY WORDS : Kincmatics, Closed-Loop Manip- 
ulator, Hybrid manipulator, Isoconditioning surfaces. 
Singularity, Working Modes. 



1 Introduction 

The aim of this paper is to study (a) a family of 
two-dof, five-bar planar linkages and (b) a derivative 
of this family, obtained when a third revolute is added 
in series to the above linkages, with the purpose of 
obtaining a three-dof manipulator. For the mechan- 
ical design of this class of manipulators, various fea- 
tures must be considered, e.g., the workspace volume, 
manipulability, and stiffness. The analysis of single- 



dof closed-loop chains is classical within the theory 
of machines and mechanisms pLj- The study of the 
workspace and the mobility of closed-loop manipula- 
tors, in turn, is given by Bajpai and Roth [2]. Gosselin 
[S], [4] conducted similar analyses for closed- loop ma- 
nipulators with one single inverse kinematic solution 
on both a planar and a spatial mechanism. One im- 
portant property of parallel manipulators is that they 
admit several solutions to both their inverse and their 
direct kinematics. This property leads to two types of 
singularities. 

The singularities of these manipulators are cor- 
respondingly associated with two Jacobian matrices 
called here the "inverse kinematics" and the "direct 
kinematics" matrices. By means of the inverse kine- 
matics matrix, we can define the "working mode" 
of the manipulator to separate the inverse kinemat- 
ics solutions. It is useful to represent the manipula- 
tor in the workspace and to define its aspects in this 
workspace. The aspects of a manipulator are defined 
in [5j. Moreover, a novel three-dof hybrid manipulator 
is proposed, which is comparable to the one proposed 
by Bajpai and Roth [2j; ours is obtained as the series 
array of a one-revolute chain and the two-dof closed- 
chain manipulator described above. In this array, the 
axis of the former intersects the axes of the two actu- 
ated joints of the latter at right angles. 

The proper operation of a manipulator depends 
first of foremost on its design; besides design, the op- 
eration depends on suitable trajectory-planning and 
control algorithms. In any event, a performance index 
needs be defined, whose minimization or maximiza- 
tion leads to an optimum operation. While various 
items come into play when assessing the operation of 
a manipulator, we focus here on issues pertaining to 



manipulability or dexterity. In this regard, we un- 
derstand these terms in the sense of measures of dis- 
tance to singularity, which brings us to the concept 
of condition number [6j. Here, we adopt the condi- 
tion number of the underlying Jacobian matrices as a 
means to quantify distances to singularity. Further- 
more, we derive the loci of points of the joint and 
Cartesian workspaces whereby the condition number 
of each of the Jacobian matrices remains constant. For 
the planar two-dof manipulators studied here, we term 
these loci the isoconditioning curves^ while, for three- 
dof spatial manipulators, these curves become the iso- 
conditioning surfaces. 



2 A Two-DOF Closed-Chain Manipu- 
lator 

The manipulator under study is a five-bar, re volute 
(i?)-coupled linkage, as displayed in Fig. [H The actu- 
ated joint variables are Oi and 6>2, while the Cartesian 
variables are the (x, y) coordinates of the revolute 
center P. 




A (0,0) B(LO,0) 

Figure 1: A two-dof closed-chain manipulator 



p = d + ^4E(p - d) 
with matrix E defined as 

3 -1 



(lb) 



E 







and c and d denoting the position vectors, in the frame 
indicated in Fig. [U of points C and respectively. 
Furthermore, note that c and d are given by 

c = ^iEc, d = ^2E(d-b) 

We would like to eliminate the two idle joint rates Os 
and O4 from eqs. (pli|) and (p!b|) . which we do upon dot- 
multiplying the former by p — c and the latter by p — d, 
thus obtaining 



(p- 



(p-c^c 



(p - d)^ p = (p - d)^d 



(2a) 
(2b) 

Equations ([2a|) and ([2b|) can now be cast in vector 
form, namely, 

Ap = (3a) 

with defined as the vector of actuated joint rates, 
of components Oi and O2. Moreover A and B are, 
respectively, the direct-kinematics and the inverse- 
kinematics matrices of the manipulator, defined as 



(p-c)^ 

(p-d)^ 



and 



B = L1L2 



sin(^3 - ^1) 






sm{0i - 62) 



(3b) 



(3c) 



Lenghts Lq, Li, 1/2, ^3, and L4 define the geom- 
etry of this manipulator entirely. However, in this 
paper we focus on a symmetric manipulators, with 
Li = I/3 and L2 = L4. The symmetric architecture of 
the manipulator at hand is justified for general tasks. 
In manipulator design, then, one is interested in ob- 
taining values of Lq, i^i, and L2 that optimize a given 
objective function under some prescribed constraints. 

2.1 Kinematic Relations 

The velocity p of point P, of position vector p, can 
be obtained in two different forms, depending on the 
direction in which the loop is traversed, namely, 

p = c + ^3E(p - c) (la) 



3 The Isoconditioning Curves 

We derive below the loci of equal condition number 
of the direct- and inverse-kinematics matrices. To do 
this, we first recall the definition of condition number 
of an m X n matrix M, with m < /t:(M). This num- 
ber can be defined in various ways; for our purposes, 
we define /t:(M) as the ratio of the largest, a^, to the 
smallest (jg, singular values of M, namely, 

K(M) = ^ (4) 

The singular values {o-k}i^ of matrix M are defined, in 
turn, as the square roots of the nonnegative eigenval- 
ues of the positive-semidefinite m x m matrix MM'^. 



3.1 Direct-Kinematics Matrix 



The condition number k of matrix B is tiius 



To calculate the condition number of matrix A, we 
need the product AA^, which we calculate below: 



AA^ = Ll 



COs(^3 



4) 



cos(6>3 — 64) 

1 



(5) 



The eigenvalues ai and 0^2 of the above product are 
given by: 

ai = 1 — cos(^3 — 6^4), 0^2 = 1 + cos(6>3 — 64) (6) 
and hence, the condition number of matrix A is 



k(A) 



(7) 



where 



1- |C0S(|93 - 6>4)| , amax = l + |cOs((93 - 6^4) | 

(8) 



Upon simplification, 



1 



|tan((^3-^4)/2)| 

In light of expression (j9|) for the condition number 
of the Jacobian matrix A, it is apparent that /^(A) 
attains its minimum of 1 when 1 6^3 — ^4] = 7r/2, the 
equality being understood modulo tt. At the other 
end of the spectrum, /^(A) tends to infinity when 
63 — 64 = /cTT, for /c = 1, 2, — When matrix A attains 
a condition number of unity, it is termed isotropic^ its 
inversion being performed without any roundoff-error 
amplification. Manipulator postures for which condi- 
tion 6s — 64 = 7r/2 holds are thus the most accurate 
for purposes of the direct kinematics of the manipu- 
lator. Correspondingly, the locus of points whereby 
matrix A is isotropic is called the isotropy locus in the 
Cartesian workspace. 

On the other hand, manipulator postures whereby 
63 — 64 = kir denote a singular matrix A. Such sin- 
gularities occur at the boundary of the Joint space of 
the manipulator, and hence, the locus of P whereby 
these singularities occur, namely, the singularity lo- 
cus in the Joint space, defines this boundary. Inter- 
estingly, isotropy can be obtained regardless of the 
dimensions of the manipulator, as long as z) it is sym- 
metric and a) L2 7^ 0. 

3.2 Inverse-Kinematics Matrix 

By virtue of the diagonal form of matrix B, its sin- 
gular values. Pi and /32, are simply the absolute values 
of its diagonal entries, namely. 

Pi = I sin(^3 - 6i)l P2 = I sin(^4 - ^2)! (10) 



^(B) 




(11) 



where, if | sin(6'3 — 6*1)! < | sin(^4 — ^2)!) then 

= |sin(03-^l)|, /?max= |sin(04-^2)|; (12) 



min 



else, 



Pn 



|sin(^4-^2)|, Pn 



\sm{6s-6i)\. (13) 



In light of expression (pT]) for the condition num- 
ber of the Jacobian matrix B, it is apparent that 
hi(B) attains its minimum of 1 when |sin(^3 — ^i)| = 
I sin (^4 — ^2)1 7^ 0. The locus of points where k^CB) = 
1, and hence, where B is isotropic, is called the 
isotropy locus of the manipulator in the joint space. At 
the other end of the spectrum, /^(B) tends to infinity 
when 1^3 — 6i\ = kn or {64 — 62] = kn, for /c = 1, 2, . . ., 
which denote singularities of B. These singularities are 
associated with the inverse kinematics of the manip- 
ulator, and hence, lie within its Cartesian workspace, 
not at the boundary of this one. The singularity lo- 
cus of B thus defines the Cartesian workspace of the 
manipulator. Therefore, the Cartesian workspace of 
the manipulator is bounded by the singularity locus 
of B, i.e., the locus of points where /^(B) 00. In- 
terestingly, B can be rendered isotropic regardless of 
the dimensions of the manipulator, as long as i) it is 
symmetric and ii) Li 7^ and L2 7^ 0. 

3.3 The Working Mode 



P(x, y) 




A (0,0) B (LO , 0) A (0,0) B (LO , 0) 

Figure 2: The four working modes 



The manipulator under study has a diagonal 
inverse-kinematics matrix B, as shown in eq. (|3cj) . the 
vanishing of one of its diagonal entries thus indicat- 
ing the occurrence of a serial singularity. The set of 
manipulator postures free of this kind of singularity is 
termed a working mode. The different working modes 
are thus separated by a serial singularity, with a set of 
postures in different working modes corresponding to 
an inverse kinematics solution. 

The formal definition of the working mode is de- 
tailed in [5j. For the manipulator at hand, there are 
four working modes, as depicted in Fig. O 

3.4 Examples 

We assume here the dimensions Lq = 6, Li = 8, 
and L2 = 5, in certain units of length that we need 
not specify. 




Figure 3: The isocon- Figure 4: The isocondi- 
ditioning curves in the tioning curves in the joint 
Cartesian space space 




The isoconditioning curves for the direct-kinematic 
matrix both in the Cartesian and in the joint spaces 
are displayed in Figs. [3] and [H respectively. A bet- 
ter representation of isoconditioning curves can be 
obtained in the Cartesian space by displaying these 
curves for every working mode, which we do in Fig. [51 

In this figure, the isoconditioning curves are the 
coupler curves of the four-bar linkage derived upon 
locking the middle joint, of center P(x, y), to yield 
a fixed value of Os — O4. Each configuration where 
points C and D coincide leads to a singularity where 
the position of point P is not controllable. 

4 A Three-DOF Hybrid Manipulator 

Now we add one-dof to the manipulator of Fig. [H 
We do this by allowing the overall two-dof manipula- 



Figure 6: The three-dof hybrid manipulator 



tor to rotate about line AB by means of a revolute 
coupling the fixed link of the above manipulator with 
the base of the new manipulator. We thus obtain the 
manipulator of Fig. [6l 

4.1 Kinematic Relations 

The velocity p of point P can be obtained in two 
different forms, depending on the direction in which 
the loop is traversed, namely, 

P = c + (i9ij + 04k) X (p - c) (14a) 

and 

P = ti+(^ij + ^5k) X (p-d) (14b) 

Upon dot-multiplying eq. (|14ap by (p — c) and 
eq. (|14bp by (p — d), we obtain two scalar equations 



free of Oi and the idle joint rates O4 and ^5, i.e., 

(p-cfp = (p-cfc (15) 
(p-d^p = (p-d)^d (16) 

Furthermore, we note that c and d are given by 

c = (^ij + ^2k)xc (17) 
d = (^ij + ^3k) X (d - b) (18) 

Substitution of the above two equations into eqs.(p!5l 
fc [T6|) . two kinematic relations between joint rates and 
Cartesian velocities are obtained, namely, 

[(p-c)xc].y2 = (p-c)^p (19) 
[(p-d)x(d-b)]-y3 = (p-dfp (20) 

Moreover, upon dot-multiplying eqs. (|14al fc b) by k, 
we obtain two expressions for the projection of p onto 
the Z axis 

k^p = k^ 



k^p = k' 



c + 6>ij X (p - c) 
d + ^ij X (p - d) 



which, in light of eqs.fpTl fc [T8|) . readily reduce to 

k^p = i^pOi 
k^p = i^pOi 

It is apparent that the right-hand sides of the two 
foregoing equations are identical, and hence, those 
two scalar equations lead to exactly the same relation, 
namely, 

k^p = (i^p)^i 

It will prove useful to have the two sides of the above 
equation multiplied by L2, and hence, that equation 
is equivalent to 

Lak^p = L2(i^p)^i (21) 

In the next step, we assemble eqs.([T9] & [2Q|) . which 
leads to an equation formally identical to eq. (|3a|) , but 
with A and B defined now as 3 x 3 matrices, i.e., 



iak^ 
(p-c)^ 
(p-d)^ 

sin ^2 + Ai sin ^4 
B=LiL2 sin(i92 - 





(22a) 





O4) 
sin(^3 - ^5) 



(p2b) 



with Ai defined as Ai =^2/^1, while vectors 6 and p 
are now given by 



(23) 
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5 The Isoconditioning Surfaces 

We conduct here the same analysis of Section [3l 

5.1 The Direct-Kinematics Matrix 

Apparently, matrix A in the 3-dof case has a struc- 
ture similar to the corresponding matrix in the 2-dof 
case. Indeed, upon calculating AA-^ in the 3-dof case, 
we obtain 



AA' = Li 



1 
1 

cos(i94 - 6>5) 





cos (^4 — ^5) 

1 



(24) 



The eigenvalues of the foregoing matrix are, then, 
ai = 1 — I cos(^4 — ^5)1, 0^2 = 1, and 0^3 = 1 + | cos(^4 — 
^5)1, the foregoing eigenvalues having been ordered as 

ai < 0^2 ^ as 
The condition number of matrix A is thus 



«(A) = 



'1 + |C0S(^4-^5)| 



1 — I COS(04 

which can be further simphfied to 
k{A) 



5)1 



1 



|tan((^4-^5)/2)| 



(25) 



Therefore, the condition number of the two direct- 
kinematics matrices, for the 2-dof and the 3-dof cases, 
coincide. However, the loci of isoconditioning points 
are now surfaces, because we have added one dof to 
the manipulator of Fig. [TJ These loci are, in fact, 
surfaces of revolution generated by the isocondition- 
ing curves of the 2-dof manipulator, when these are 
rotated about the axis of the first revolute. We repre- 
sent the boundary of the workspace (Fig. [7j). 

5.2 The Inverse-Kinematics Matrix 

Given the diagonal structure of matrix B, its sin- 
gular values are apparently, { LiL2/3i }f , with the def- 
initions below: 

/3i = I sin ^2 + Ai sin ^4 1, 
P2 = |sin(02-^4)|, 
/33 = |sin(^3-^5)| 

Therefore, the isoconditioning locus of B is deter- 
mined by the relation 



I sin 6*2 + Ai sin 6*41 = | sin(6'2 - 6*4)! = | sin(6'3 - 6*5) 



(26) 




Figure 7: The boundary of the workspace 



Notice that the distance di of P to the Y axis is 

di = Li sin O2 + L2 sin O4 = Lipi (27) 

Likewise, the distances d2 and ds of P to the two axes 
of the other two actuated revolutes, i.e., those passing 
through A and B are, respectively, 

d2 = L2P2 (28) 
ds = L2P3 (29) 

It is now straightforward to reahze that, for the case 
at hand, the locus of isotropic points of B are given by 
manipulator postures whereby P is equidistant from 
the three actuated revolute axes. Likewise, postures 
whereby point P lies on the Y axis are singular; at 
these postures, /^(B) tends to infinity. Moreover, the 
inverse-kinematics singularities occur whenever any of 
the diagonal entries of B vanishes, i.e., when 

di = 0, or 6>2 = 6>4 + kn, or O3 = O5 -\- kn (30) 

for A: = 1,2,.... 

6 Conclusions 

We have defined a new architecture of hybrid ma- 
nipulators and derived the associated loci of isocondi- 
tioning points. Two Jacobian matrices were identified 
in the mapping of joint rates into Cartesian veloci- 
ties, namely, the direct-kinematics and the inverse- 
kinematics matrices. Isoconditioning loci were defined 
for these matrices. Two special loci were discussed, 
namely, those pertaining to isotropy and to singular- 
ity, for each of these matrices. 

The study has been conducted for three-dof-hybrid 
manipulators but applies to six- dof- hybrid manipula- 
tors with wrist as well. 



The hybrid manipulators studied have interest- 
ing features like workspace and high dynamic perfor- 
mances, which are usually met separately in serial or 
parallel manipulators, respectively. Futher research 
work is being conducted by the authors on such hy- 
brid manipulators with regard to their optimal design. 
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